Carpet drift estimation using differential sensors or visual measurements

ABSTRACT

Apparatus and methods for carpet drift estimation are disclosed. In certain implementations, a robotic device includes an actuator system to move the body across a surface. A first set of sensors can sense an actuation characteristic of the actuator system. For example, the first set of sensors can include odometry sensors for sensing wheel rotations of the actuator system. A second set of sensors can sense a motion characteristic of the body. The first set of sensors may be a different type of sensor than the second set of sensors. A controller can estimate carpet drift based at least on the actuation characteristic sensed by the first set of sensors and the motion characteristic sensed by the second set of sensors.

RELATED APPLICATIONS

This application is a continuation of U.S. patent application Ser. No.15/221,036 filed Jul. 27, 2016, which is a continuation of U.S. patentapplication Ser. No. 14/949,002 filed Nov. 23, 2015, now U.S. Pat. No.9,427,875, which is a continuation of U.S. patent application Ser. No.13/913,258 filed Jun. 7, 2013, now U.S. Pat. No. 9,223,312, which claimsthe benefit of U.S. Provisional Application No. 61/657,399 filed Jun. 8,2012, the contents of which are hereby incorporated by reference intheir entirety.

TECHNICAL FIELD

The disclosure relates to robotic systems, and more particularly, tomobile robotic systems configured to move across a surface.

BACKGROUND

Autonomous robots are robots which can perform desired tasks inenvironments without continuous human guidance. Robots may be autonomousto different degrees and in different ways. For example, an autonomousrobot can traverse a work surface of an unstructured environment withoutcontinuous human guidance to perform one or more tasks. In otherexamples, an autonomous robot may perform tasks in structuredenvironments or with human supervision. In the field of home, officeand/or consumer-oriented robotics, mobile robots have been adopted forperforming functions such as vacuum cleaning, floor washing, patrolling,lawn cutting, and other such tasks.

However, many conventional autonomous robots do not adequately orprecisely determine robot position and/or pose and do not adequatelycontrol the robot's movements to ensure the robot stays on a given routeand/or reach a designated position and/or pose.

SUMMARY

The following presents a simplified summary of one or more aspects inorder to provide a basic understanding of such aspects. This summary isnot an extensive overview of all contemplated aspects, and is intendedto neither identify key or critical elements of all aspects nordelineate the scope of any or all aspects. Its sole purpose is topresent some concepts of one or more aspects in a simplified form as aprelude to the more detailed description that is presented later. Inparticular, contemplated aspects include methods and non-transitorycomputer-readable medium embodying some or all concepts of one or moreaspects described herein.

Systems and methods are described for estimating drift, such as carpetdrift, experienced by a robot moving across a surface, such as a carpet,and for compensating for such drift, such as carpet drift. By way offurther example, certain systems and methods described may be configuredto estimate drift due to other effects that may impact the motion of arobot traversing a surface, such as motion drift due to sloped floors,unstable surfaces (e.g., sand or dirt surfaces), and/or due to windpushing or pulling the robot.

Certain example embodiments contemplate a robotic device. The roboticdevice comprises a body and an actuator system configured to move thebody across a surface. The robotic device can further comprise a firstset of sensors configured to sense an actuation characteristic of theactuator system. The robotic device can further comprise a second set ofsensors configured to sense a motion characteristic of the body. Thefirst set of sensors can be a different type of sensor than the secondset of sensors. The robotic device can further comprise a controllerconfigured to estimate drift, such as carpet drift, based at least onthe actuation characteristic sensed by the first set of sensors and themotion characteristic sensed by the second set of sensors. In an exampleembodiment, the actuator system may include a rotatable wheel and thefirst set of sensors is configured to sense rotation of the wheel of theactuator system. The second set of sensors may include a gyroscopicsensor configured to sense rotation of the body. In an exampleembodiment, the actuator system includes a rotatable wheel and the firstset of sensors is configured to sense rotation of the wheel of theactuator system. The second set of sensors includes a gyroscopic sensorconfigured to sense rotation of the body. The controller is furtherconfigured to estimate carpet drift based at least on a comparisonbetween a heading estimated from the sensed wheel rotation and a headingestimated from the sensed body rotation. In an example embodiment, thecontroller is further configured to control the actuator system toperform a maneuver that rotates the body at least about 180 degrees. Thecontroller is further configured to estimate the carpet drift based atleast on a plurality of comparisons between actuation characteristicsand motion characteristics sensed during the maneuver. In an exampleembodiment, the controller is further configured to estimate a magnitudeof the carpet drift based at least on a ratio of total drift to changeof heading during a maneuver. In an example embodiment, the controlleris further configured to update the estimated carpet drift based atleast on a plurality of comparisons between actuation characteristicsand motion characteristics sensed during a maneuver in response todetecting an obstacle. In an example embodiment, the actuator systemincludes a rotatable wheel and the first set of sensors is configured tosense rotation of the wheel of the actuator system. The second set ofsensors includes an image sensor configured to capture two or moreimages. The controller is configured to estimate the motioncharacteristic by comparing the two or more images. In an exampleembodiment, the controller is further configured to detect a commonfeature in each of the two or more images, wherein the controller isfurther configured to estimate the heading of the body based at least oncomparing a change in a relative position of the common feature detectedin the two or more images.

In example embodiments, a robotic device is contemplated. The roboticdevice comprises left and right rotatable drive wheels. The roboticdevice also comprises a drive sub-system configured to rotate the leftand right drive wheels differentially based on a drive signal such thatthe robotic device moves over a surface. The robotic device alsocomprises a first set of sensors configure to generate odometrymeasurements of rotations of the left and right wheels. The roboticdevice also comprises a second set of sensors configured to generateheading measurements of the robotic device. The robotic device alsocomprises a controller configured to generate the drive signal such thatthe robotic device performs a maneuver having a change in heading angle.The controller is further configured to estimate a drift, such as carpetdrift, based at least on estimates of change in heading during themaneuver and changes in the heading measurements during the maneuver.The estimates of changes in heading is based on the odometrymeasurements during the maneuver. In an example embodiment, thecontroller is further configured to continue the maneuver at least untilthe heading measurement indicates a change in heading of at least about180 degrees. The controller is further configured to collect a pluralityof odometry measurements during the maneuver. The controller is furtherconfigured to collect a plurality of heading measurements during themaneuver. The controller is further configured to estimate the carpetdrift based at least on comparisons between the plurality of odometrymeasurements and the plurality of heading measurements. In an exampleembodiment, the controller is further configured to estimate the carpetdrift at least partly in response to encountering an obstacle. In anexample embodiment, the controller is further configured to estimate thecarpet drift in response to traveling a distance greater than athreshold distance since a previous estimate was performed.

Certain example embodiments contemplate a mobile robotic device. Themobile robotic device comprises a first set of sensors configured togenerate odometry measurements. The mobile robotic device comprises asecond set of sensors is configured to generate heading measurements ofthe mobile robotic device. The mobile robotic device comprises a cameraconfigured to capture images. The mobile robotic device comprises acontroller communicatively coupled to the first and second sets ofsensors and to the camera. The controller is configured to selectivelyoperate in a first mode and selectively operate in a second mode. Whenoperating in the first mode, the controller is further configured toestimate a drift, such as carpet drift, based at least on a headingestimated from the odometry measurements and on the heading measurementsgenerated by the second set of sensors. When operating in the secondmode the controller is further configured to generate visualobservations of motion of the mobile robotic device based at least ontwo or more images of the images captured by the camera. The controlleris further configured to estimate a carpet drift based at least on theodometry measurements and the visual observations of motion. The mobilerobotic further comprises differentially driven drive wheels. Thecontroller is further configured to operate in the first mode if anabsolute differential rotation of the drive wheels is greater than athreshold. In an example embodiment, the controller is furtherconfigured to compute an uncertainty associated the visual observationsof motion, and wherein the controller is further configured to operatein the second mode if the uncertainty is below a threshold.

DESCRIPTION OF DRAWINGS

These drawings and the associated description herein are provided toillustrate specific embodiments of the invention and are not intended tobe limiting.

FIG. 1 is a schematic diagram illustrating a top view of an examplerobotic device.

FIG. 2 is a schematic diagram illustrating an example embodiment of anexample actuator system of the robotic device of FIG. 1.

FIG. 3 is a schematic diagram illustrating an example embodiment of anexample controller of the robotic device of FIG. 1.

FIG. 4 is a flow diagram an example method of estimating carpet drift.

FIG. 5 is a flow diagram illustrating an example embodiment of anexample method of estimating carpet drift based at least on measurementsfrom odometry and gyroscopic sensors.

FIG. 6 is a flow diagram illustrating an example embodiment of anexample method of estimating carpet drift based at least on measurementsfrom odometry and image sensors.

FIG. 7 is a flow diagram illustrating an example embodiment of anexample method of determining visual observation of motion.

FIG. 8 is a flow diagram illustrating an example embodiment of anexample method of executing a statistical filter.

DETAILED DESCRIPTION

Methods and systems are described for estimating drift, such as carpetdrift. Example embodiments are described herein in the context ofsystems and methods for estimating carpet drift experienced by acleaning robot, but will be applicable to other types of devices, suchas mobile robotic devices capable of traversing a carpeted surface. Itis understood that the term carpet is intended to include rugs and otherfloor coverings that may have a grain or nap. It is also understood thatexample embodiments described herein will be applicable to estimatingdrift due to effects other than carpet effects, such as, by way ofexample, motion drift due to sloped floors, unstable surfaces (e.g.,sand or dirt surfaces), and/or due to wind forces (e.g., relativelyconstant or slowly time-varying wind pushing or pulling on the robot).

The manufacturing process of carpets may align the carpet's fibers suchthat the fibers tend to bend in a particular direction. This directionthat the fibers are biased may be referred to as the carpet's graindirection or nap direction. The effect of the grain direction may beexperienced by an object when the object moves over the carpet, forexample, by vacuuming the carpet or running your hand over the carpet.If the object moves across the carpet along the grain direction, thefibers of the carpet may tend to fall down in the direction of themotion, thereby aiding robot movement in the grain direction. However,if the object moves against the grain direction, the fibers of thecarpet may tend to stand up, thereby resisting or inhibiting robotmovement.

The direction-dependent forces of the carpet due to the carpet grainacting upon a moving object can influence the motion of the object. Forexample, the trajectory of an autonomous cleaning device may bedisturbed by the influence of the carpet grain. The effect of the carpetgrain on the motion of the object may be referred to as carpet drift.Carpet drift may be represented by a carpet drift vector, which has botha magnitude and a direction. The carpet drift vector may be a propertyof the carpet.

For autonomous robots, carpet drift can pose a problem. In particular,an autonomous robot may rely on estimates of its position and/ororientation determined by using sensors such as wheel encoders,gyroscope, accelerometers, and/or the like sensors. For example, a wheelencoder sensor may be used to determine a distance traveled based onsensing an amount that the wheels of the robotic device rotated during aperiod of time. However, when an autonomous robot navigates in acarpeted environment, its wheels can make the carpet fibers stand up orfall down based on the motion of the robot relative to the carpet grain.In particular, when the fibers fall down along the carpet grain, thecarpet can push or guide the robot in the direction of the carpet grain.As a result, the robot can travel a distance greater than the distancedetermined based on the wheels' rotations when the robot moves in thedirection of the carpet grain. On the other hand, when the robot travelsover erect fibers against the carpet grain, the robot can travel adistance less than the distance determined based on the wheels'rotations. In either case, the actual distance traveled may be differentthan the distance measured by the sensors, such as the wheel encodersand the like sensors used for dead-reckoning.

While the carpet drift vector direction may be fixed or constant in theenvironment for a particular carpet, the amount of drift may beproportional or somewhat related to the distance traveled. Hence, theposition estimate error can accumulate over time as the robot traversesthe carpet. Accordingly, the robot may not be able to build an accuratemap of the environment or may not be able to navigate the environmentefficiently, accurately, and/or safely for carrying out tasks such asvacuuming.

Estimates of the carpet drift can optionally be generated based in wholeor in part on the motion of the robotic device that is not accounted forby its odometry sensors (e.g., integrated differential motion sensors).In particular, carpet drift may optionally be estimated by combining twoor more types of sensor measurements. In an example embodiment,measurements from a sensor can provide an indication of the desiredmotion or commanded motion, and measurements from another sensor (e.g.,a different type of sensor) can provide an indication of the true oractual motion. For example, in an example embodiment, odometry sensors(e.g., one or more sensors that measure wheel rotation amounts) mayprovide an indication of the desired or commanded motion based onmeasured or commanded wheel rotations. Other characteristics of theactuator system may be used in addition or instead, such as wheelvelocity, wheel acceleration, and/or the motor control signals. The truemotion, such as changes in the robotic devices orientation or heading,may be estimated using, for example, data from gyroscopic sensors, imagesensors, or any combination of the like sensors or other sensors. Thecarpet drift (or carpet drift vector) may be estimated by comparing thedesired motion and the actual motion.

Estimates of the carpet drift may be used to improve or correct themotion estimate. For example, the estimated carpet drift vector may beused with a motor controller to compensate for the effects of carpetgrain and/or may be used to generate a correction term to adjustodometry data. Estimates of the carpet drift may also be used toestimate whether the robot is on carpeted or non-carpeted floor.

FIG. 1 is a schematic diagram illustrating a top view of an examplerobotic device 100 (although it is understood that the internalcomponents of the robotic device are shown schematically and theillustration is not intended to depict that actual positioning orlocation of such internal components within the robotic device 100). Therobotic device 100 includes a body 102, an actuator system 104, acommunication bus 106, a controller 108, a first set of sensors 110, asecond set of sensors 112, a third set of sensors 114, and a cleaningmechanism 116.

The body 102 can include structures that form the exterior surfaces ofthe robotic device 100 as well as various internal structures, such as achassis. Accordingly, the body 102 may be configured to house theactuator system 104, the communication bus 106, the controller 108, thefirst set of one or more sensors 110, the second set of one or moresensors 112, the third set of one or more sensors 114, and the cleaningmechanism 116. It is understood that fewer or additional sets of sensorsmay be used.

The exterior surfaces of the example robotic device 100 can define anyapplicable shape, including but not limited to shapes having top-viewprofiles that define substantially straight edges, such as a rectangularand triangular configurations, or one or more substantially curved orarcuate edges, such as circular, oval, and D-shaped configurations;however, the body 102 may define other shapes as well. In operation, theexterior surfaces may become in contact with obstacles, such as a wall.Accordingly, the exterior surface of the body 102 may include portionsformed from material having friction coefficients that allows therobotic device 100 to slidably move along such obstacles.

The actuator system 104 is configured to move the body 102 across asurface, such as a carpeted and/or non-carpeted floors. For example, theactuator system 104 can receive a drive command from the controller 108via the communication bus 106 for controlling an actuator motion orforce generated by the actuator system 104, such as driving one or morewheels to rotate on the surface. The actuator system 104 and the body102 may be operatively coupled such that the generated actuator motionor force causes the body 102 to move. The actuator system 104 caninclude any applicable number of motor, wheel, transmission, and thelike assemblies for generation of a force for causing movement of thebody 102. The actuator system 104 will be described in greater detaillater in connection with FIG. 2.

The communication bus 106 is configured to communicatively interconnectthe actuator system 104, the controller 108, and the first, second, andthird sets of sensors 110, 112, 114. The communication bus 106 cantransmit electrical, optical, and/or mechanical signals. Although theillustrated embodiments shows the communication bus 106 as a shared bus,it will be appreciated by one skilled in the art that otherconfigurations may be implemented, such as additional or alternativecommunication channels between any individual or subgroups of theactuator system 104, the controller 108, and the first, second, andthird sets of sensors 110, 112, 114.

The controller 108 may be configured to receive data/measurements fromthe sensors 110, 112, 114 as inputs and to estimate drift, such ascarpet drift. For example, the controller 108 may be configured toestimate drift, such as carpet drift, based at least on the actuationcharacteristic sensed by the first set of sensors 110 and the motioncharacteristic sensed by the second set of sensors 112 received from thecommunication bus 106. Examples of the actuation characteristic include,but are not limited to, wheel rotational positions, rates,accelerations, and/or like actuator measurements that provide anindication of the commanded or desired movement. For example, if therobotic device 100 is moved by wheels of the actuator system 104, thedesired displacement of the robotic device 100 may be estimated byodometry (e.g., based on the amount rotations of the wheels and thediameter of the wheels). Examples of the motion characteristic include,but are not limited to, rotational characteristics (e.g., angularorientation, velocity, and/or acceleration) of the body 102, the pathangle (e.g., the angle or change in angle of the velocity vector of therobotic device 100 in the room coordinates), and/or like measurementsthat provide an indication of the true motion of the robotic device 100.For example, gyroscopic sensors can provide measurement of therotational changes of the orientation of the robotic device 100. As anadditional example, imaging sensors can provide measurements related topath angle of the device.

In addition, the controller 108 may be configured to control theoperation of the actuator system 104 and/or the cleaning mechanism 116.For example, the controller 108 can send control signals to the actuatorsystem 104 via the communication bus 106 to move the robotic device 100in a desired trajectory. In addition, in some embodiments, thecontroller 108 can engage the cleaning mechanism 116 by sending acontrol signal to the actuator system 104, or to the cleaning mechanism116 directly. The controller 108 will be described in greater detaillater with reference to FIG. 3.

The first set of sensors 110 may be configured to sense an actuationcharacteristic of the actuator system 104. For example, the first set ofsensors 110 may be coupled to the actuator system 104. In a particularembodiment, the first set of sensors 110 can include one or moreodometry sensors, such as linear or rotary encoders coupled to one ormore wheels of the actuator system 104, or sensors or modules thatmeasure or collect control or power signals supplied to the actuatorsystem 104. These measurements can provide a way to estimate motion ofthe robotic device 100 by odometry or dead-reckoning methods. However,the estimates may deviate from the actual motion, for example, due tocarpet drift.

The second set of sensors 112 may be configured to sense a motioncharacteristic of the body 102. For example, the first set of sensors110 may be coupled to the body 102 for sensing the motion characteristicrelative to the environment or an inertial frame. The sensed motioncharacteristic may be provided to the controller 108 via thecommunication bus 106. In an example embodiment, the second set ofsensors 112 can include one or more gyroscopic sensors for sensingrotation of the body 102. In another embodiment, the second set ofsensors 112 can in addition or instead include one or more image sensorsfor capturing images of the environment for estimating the path angle ofthe robotic device 100.

The third set of sensors 114 can optionally be included for sensing asecond motion characteristic of the body 102. For example, while someembodiments of the robotic device 100 can sense changes in only one ofbody rotation or path angle, other embodiments can sense both optionallyusing, for example, the second and third sets of sensors 112, 114.Accordingly, in an example embodiment the robotic device 100 can includeone or more gyroscopic sensors, compass sensors, and/or accelerometersfor sensing rotation of the body 102 (e.g., corresponding to the secondset of sensors 112) and can include one or more image sensors forimaged-based heading estimates (e.g., corresponding to the third set ofsensors 114).

As stated, each of the first, second, and third sets of sensors 110,112, 114 may optionally be a different type of sensor. For example, inan example embodiment the first set of sensors 110 can include one moreodometry sensors, the second set of sensors 112 can include one or moregyroscopic sensors, and the optional third set of sensors 114 caninclude one or more image sensors.

The cleaning mechanism 116 may be configured to capture dirt from thesurface. For example, the cleaning mechanism 116 can include a brush,cleaning mat and/or a vacuum assembly coupled to the body 102 andpositioned such that it can capture dirt from the surface as the roboticdevice 100 traverses the surface. In some embodiments, the cleaningmechanism may be configured to be powered by the actuator system 104,for example, to power a brush assembly (which may be a pliablemulti-vane beater or a have pliable beater flaps between rows of brushbristles) and create suction for vacuuming. It will be appreciated thatthe cleaning mechanism 116 need not be included and is optional.

In operation, the controller 108 can command the actuator system 104 tomove the robotic device 100 a desired displacement (and/or at a desiredvelocity), represented in the illustrated embodiment by the vector a. Asstated, a carpeted floor may affect the motion of the robotic device 100due, in part, to the carpet grain of the carpet. Accordingly, therobotic device 100 can experience carpet drift, represented in theillustrated embodiment by the vector b. The actual displacement vector cmay be a superposition of the desired displacement vector a and thecarpet drift vector b.

In operation, the controller 108 may receive measurement from the firstset of sensors 110 via the communication bus 106. For example, themeasurements of the first set of sensors 110 may be related to thedesired displacement vector a. In addition, the controller 108 canreceive measurements from the second set of sensors 112 via thecommunication bus 106. For example, the measurements of the second setof sensors 112 may be related to the actual motion vector b. Based (inwhole or in part) on these measurements, the controller 108 can estimatethe effect of the carpet drift vector c. The estimate can aid incorrecting measurements (e.g., odometry measurements) from the first setof sensors 110 and/or compensate for carpet drift.

FIG. 2 is a schematic diagram illustrating an example embodiment of anactuator system 104 of the robotic device 100 of FIG. 1. The actuatorsystem 104 includes a left rotatable wheel 202, a right rotatable wheel204, a left transmission assembly 206, a right transmission assembly208, and a drive sub-system 210.

The drive sub-system 210 may be configured to generate power forrotating the left and right rotatable wheels 202, 204 for moving therobotic device 100. For example, the left transmission assembly 206 maybe configured to transmit mechanical power generated by the drivesub-system 210 to rotate the left wheel 202. Similarly, the righttransmission assembly 208 may be configured to transmit mechanical powergenerated by the drive sub-system 210 to rotate the right wheel 204. Theleft and right wheels 202, 204 may be driven differentially. Forexample, the drive sub-system 210 can drive the left wheel 202 at avelocity vi and the right wheel 204 independently at a velocity v_(r).Varying the differential velocities of the left and right wheels 202,204 can turn the robotic device 100 by a radius based on the magnitudeof the differential velocities and a distance L of the wheelbase (e.g.,the distance between the left and right wheels 202, 204). Accordingly,the illustrated embodiment of the actuator system 104 may be configuredto move the robotic device 100 as the wheels 202, 204 rotate in contactwith the floor on a controllable path or heading.

It will be appreciated that any applicable wheel type may be selected,and that each of the left and right wheels 202, 204 may be part of aleft and right wheel sub-systems (not shown) that can include aplurality of left wheels interconnected by a left track, and a pluralityof right wheels interconnected by a right track, similar to the drivesystem of a tank. It will be further appreciated that in otherembodiments the actuator system 104 can include one or more left legsand one or more right legs for providing movement. It will be furtherappreciated that in yet other embodiments the actuator system 104 caninclude one or more rotatable and pivotable wheels configured to movethe robotic device 100 as it rotates, in a variable direction inaccordance with the angle that the wheels are pivoted.

When the robotic device 100 is moving along the direction of the carpetgrain, the displacement estimated by the rotation of the wheels 202, 204(e.g., by odometry) may be less than the actual displacement. When therobotic device 100 is moving and going against the direction of thecarpet grain, the effect may be reversed in whole or in part. In theillustrated embodiment of FIG. 2, the carpet drift vector c is at anangle θ with respect to the robot wheelbase. For example, if the leftwheel 202 is being driven at velocity v_(l) and the right wheel 204 atvelocity v_(r), the robotic device 100 would drive in an arc defined byv_(l), v_(r), and L in the absence of carpet drift and wheel slippage.However, the carpet drift can move the robotic device 100 in thedirection of the carpet drift vector c and the actual displacement maybe different from the desired one.

To further illustrate, if the left and the right wheels 202, 204 move adistance d_(l) and d_(r), respectively, during a duration (e.g., a unittime), this motion may be sensed by a displacement sensor such as wheelodometry sensors. The change in heading caused by this motion (e.g.,absent carpet drift, wheel slippage, and the like actuator disturbances)may be approximately modeled by the following example equation:

$\begin{matrix}{{\Delta\alpha}_{odom} = \frac{d_{r} - d_{l}}{L}} & \left( {{Equation}\mspace{14mu} 1} \right)\end{matrix}$

Accounting for carpet drift in the direction of the wheel travel, theactual displacement for each of the wheels can include a dot productbetween the carpet drift vector c and wheel motion direction as anadditional term. As a result, the actual left and right displacementsd_(lc), d_(lr) may be approximately modeled by the following exampleequations:

d _(lc) =d _(l) +d _(l) |c|sin(θ)=d _(l)+sgn(d _(l))|d _(l)∥c|sin(θ)  (Equation 2a)

d _(rc) =d _(r) +d _(r) |c|sin(θ)=d _(r)+sgn(d _(r))|d _(r)∥c|sin(θ)  (Equation 2b)

Given this displacement, the change in heading, which is what may bemeasured by a heading sensor like a gyroscope, may be approximatelymodeled by the following example equation:

$\begin{matrix}\begin{matrix}{{\Delta\alpha}_{gyro} = \frac{d_{rc} - d_{lc}}{L}} \\{= {\frac{d_{r} - d_{l}}{L} + {\frac{\left( {{d_{r}} - {d_{l}}} \right)}{L}{c}{\sin (\theta)}}}}\end{matrix} & \left( {{Equation}\mspace{14mu} 3} \right)\end{matrix}$

The change in heading due to carpet drift may be estimated by taking thedifference between the change in heading computed from odometry and thechange in heading computed from a gyroscopic sensor:

$\begin{matrix}\begin{matrix}{{\Delta\alpha}_{drift} = {{\Delta\alpha}_{gyro} - {\Delta\alpha}_{odom}}} \\{= {\frac{\left( {{d_{r}} - {d_{l}}} \right)}{L}{c}{\sin (\theta)}}}\end{matrix} & \left( {{Equation}\mspace{20mu} 4} \right) \\{{\Delta\alpha}_{drift} \propto {\sin (\theta)}} & \left( {{Equation}\mspace{14mu} 5} \right)\end{matrix}$

As is evident in Equation 5, the difference in heading computed from adisplacement sensor (such as an odometry sensor) and a heading sensor(such as a gyroscope) may be proportional to the carpet drift directionwith respect to the robot heading. From Equation 4, the absolutedisplacement of the individual wheels should be substantially differentand constant. Thus, if the robot is made to cover all the possibleorientations (e.g., move in an arc to cover a complete rotation), thedifference in heading as estimated by Equation 5 should result in asinusoidal function. The maxima and the minima of the sinusoid shouldoccur when the robot is approximately aligned in the direction of thecarpet grain and in the opposite direction of the carpet grain,respectively.

FIG. 3 is a schematic diagram illustrating an example embodiment of acontroller 108 of the robotic device 100 of FIG. 1. The controller 108includes a processor 302 and memory 304. The memory 304 includes anactuator module 306, a sensor module 308, a controller module 310, andan estimation module 312.

The processor 302 includes circuitry, such as a microprocessor ormicrocontroller, configured to execute instructions from memory 304 andto control and operate the actuator system (e.g., the actuator system104 of FIG. 1), sensors (e.g., first, second, and third sets of sensors110, 112, 114 of FIG. 1), cleaning mechanisms (e.g., the cleaningmechanism 116 of FIG. 1), and/or the like components of the roboticsystem 100. In particular, the processor 302 may be a general purposesingle- or multi-chip microprocessor (e.g., an ARM), a special purposemicroprocessor (e.g., a digital signal processor (DSP)), amicrocontroller, a programmable gate array, etc. Although a singleprocessor 302 is shown in the controller 108, in an alternativeconfiguration, a combination of processors (e.g., ARMs and DSPs) couldbe used.

The memory 304 includes tangible non-transitory computer-readablemediums configured to store information by chemical, magnetic,electrical, optical, or the like means. For instance, the memory 304 maybe a non-volatile memory device, such as flash memory or a hard-diskdrive, and/or a volatile memory device, such as dynamic-random accessmemory (DRAM) or static random-access memory (SRAM), or a system of acombination of non-volatile and volatile memories.

Within the memory 304 is the actuator module 306 that includesinstructions that configure the processor 302 to operate the actuatorsof the robotic device 100. For example, the actuator module 306 mayinclude instructions that enable various modules residing in the memory304 to use the actuator system 104 of FIG. 1. In particular, theactuator module 306 may include instructions that form a driver forcontrolling communication of data and control messages between thecontroller 108 and the actuator system 104 of FIG. 1.

Within the memory 304 is the sensor module 308 that includesinstructions that configure the processor 302 to operate the sensors ofthe robotic device 100. For example, the sensor module 308 can includeinstructions that enable various modules residing in the memory 304 touse the sensors 110, 112, 114 of FIG. 1. In particular, the sensormodule 308 can include instructions that form a driver for controllingcommunication of data and control messages between the controller 108and the sensors 110, 112, 114 of FIG. 1.

Within the memory 304 is the controller module 310 that includesinstructions that configure the processor 302 to control the actuators104 and the sensors 110, 112, 114 of the robotic system 100, as well asthe execution of the actuator module 306, the sensor module 308, and theestimation module 312. For example, the controller module 310 caninclude instruction related to generating control signals (e.g., motorcontrol laws) for the actuators and for calling instructions of theactuator module 306 for sending the generated control signals to theactuator system 104. The controller module 310 can include instructionsrelated to calling instructions of the sensor module 308 for receivingthe measurements from the sensors 110, 112, 114. The controller module310 can include instructions controlling the execution of instructionsof the estimation module 312 for estimating carpet drift.

Within the memory 304 is the estimation module 312 that includesinstructions that configure the processor 302 to estimate carpet drift.Various methods implemented by the example estimation module 312 will bedescribed in greater detail below in connection with FIGS. 4-8.

FIG. 4 is a flow diagram of method 400 of estimating carpet drift. In anexample embodiment, the robotic device 100 executes instructions of theestimation module 312 in memory 304 for performing the operations of themethod 400. The method 400 starts at block 402 and proceeds to block 404for moving the robotic device 100 in a pattern. For example, thecontroller 108 can command actuator system 104 to move the roboticdevice 100 across a surface. In some embodiments, moving the roboticdevice 100 may be part of a carpet-drift calibration phase (for example,during an initial operation on the surface or upon start-up). Forinstance, during a calibration process, the robotic device 100 may becommanded to perform a maneuver that rotates the robotic device 100 atleast about 180 degrees or at least about 360 degrees. Rotating therobotic device at least 180 degrees enables the robotic device to alignat least with or against the carpet drift vector during the rotation.Accordingly, the direction of the carpet drift vector c may beestimated, for example, by Equation 5 and determining the location ofmaxima/minima of Δα_(drift). Rotating the robotic device at least 360degrees enables the robotic device to align with and against the carpetdrift vector during the rotation. Accordingly, the direction of thecarpet drift vector c may be estimated, for example, by Equation 5 anddetermining the location of maxima and/or minima of Δα_(drift).Additionally or alternatively, the movement of the robotic device 100may be performed as part of a separate task, such as covering orcleaning a space. For example, the maneuver may be a turn made inresponse to encountering an obstacle, such as a wall. As anotherexample, the maneuver may optionally be a substantially straight path,for example, as the robotic device 100 traverses from a first wall to asecond wall.

During or concurrently with the operation of block 404, the method 400can perform block 406 for sensing an actuation characteristic of anactuator system of the robotic device 100. For example, the controller108 can receive a plurality of measurements of the actuationcharacteristic using the first set of sensors 110. The actuationcharacteristic, for instance, can correspond to rotations of one or morewheels of the actuator system 104 to generate odometry. As discussedabove in connection with FIG. 3, odometry measurements may be used toestimate the desired change in heading of the robotic device 100.

During or concurrently with the operation of block 404, the method 400may perform block 408 for sensing a motion characteristic of the roboticdevice 100. For example, the controller 108 can receive a plurality ofmeasurements of the motion characteristic using the second or third setsof sensors 112, 114. The motion characteristic, for instance, cancorrespond to a change in the rotation of the robotic device 100 sensedby a gyroscopic sensor or a change in the path angle sensed by an imagebased sensor.

After collecting measurements of each of the actuation characteristicand the motion characteristic, the method 400 can proceed to block 410for estimating carpet drift based at least on the actuationcharacteristic and the motion characteristic. For example, thecontroller 108 may compare measurements of the actuation characteristicand the motion characteristic collected while the robotic device 100performed a maneuver. The process of estimation performed at block 410can depend on the nature of the motion characteristic. For example, thecontroller 108 may use one method (e.g., method 410 a of FIG. 5) ofestimation if the motion characteristic is related to a rotation of therobotic device 100 and another method (e.g., method 410 b of FIG. 6) ofestimation if the motion characteristic is related to a path angle. Bothof such example methods of estimation are described in further detaillater in connection with FIGS. 5-8.

Additionally or alternatively, the method of estimation can depend onthe maneuver performed at block 404. For example, if the maneuverincludes a substantial rotation, such as a rotation of at least about180 degrees or at least about 360 degrees, the method of estimation maybe in accordance with the description below in reference to FIG. 5. Ifthe maneuver includes a substantially straight desired trajectory-suchas a desired trajectory corresponding to commanded differentialrotations or velocities of left and right wheels (e.g., wheels 202, 204of FIG. 3) being less than about 10% or less than about 20%different—the process of estimation may be in accordance with thedescription below with reference to FIGS. 6-8. It will be appreciated,however, by one skilled in the art that the process of estimation ofFIGS. 6-8 may not require substantially straight desired trajectories,and other trajectories, such as curved trajectories, may be used.

Once the carpet drift is estimated, the method 400 continues to block412 for applying carpet drift correction. For example, odometry readingsmay be corrected by adding a drift component proportional or otherwiserelated to the grain magnitude in the grain direction. The correctedodometry values may be used to estimate the robot position. Thecorrection can significantly improve dead-reckoning of the roboticdevice 100 on carpeted floors.

The method 400 may optionally be run at intervals over the run of therobotic device 100 in order adjust the carpet drift estimation andimprove position estimates. For example, the method 400 may be runperiodically with respect to time or distance traveled. For example,robotic device 100 may be configured to run the method 400 after or inresponse to traveling a distance greater than a threshold distance(which may optionally be pre-specified) since the previous estimate wasperformed. In addition, the method 400 may optionally be performed toevaluate whether the robotic device 100 is operating in a multi-carpet(or multi-surface) environment. For example, different carpeted surfacecan have different carpet drift vectors associated with them. Method 400may be performed a number of times to generate multiple carpet driftestimates. If the carpet drift estimates differ, then it may beestimated or determined that there exists multiple carpeted surfaces. Inaddition, if the carpet drift estimate indicate no or substantially nocarpet drift, then it may be estimated or determined that the vehicle isoperating on a non-carpeted surface. Once the method 400 completes, itcan proceed to block 414 to end.

FIG. 5 is a flow diagram illustrating an example embodiment of a method410 a of estimating carpet drift based at least on measurements fromodometry and gyroscopic sensors. For example, the method 410 a may beexecuted as part of a calibration phase for corrected odometry with theestimated carpet drift. The method 410 a may also be executed duringperformance of a task to adjust the estimated carpet drift. For example,the method 410 a may be executed while the robotic device 100 iscleaning the surface of a room. In particular, the method 410 a may beexecuted when the robotic device 100 rotates, for example, in responseto encountering or navigating around an obstacle. One optionaladvantage, among others, of certain embodiments that use a gyroscopicsensor may be improved accuracy and reduced complexity in terms ofhardware, implementation, and runt-time computations, as compared to,for example, image based sensors. In an example embodiment, the roboticdevice 100 executes instructions of the estimation module 312 in memory304 for performing the operations of the method 410 a.

The method 410 a starts at block 502 and proceeds to block 504 forcomparing a plurality of first and second heading estimates. Forexample, prior to starting the method 410 a at block 502, measurementsmay be collected while the robotic device 100 performs a maneuverincluding, for instance, a full rotation by pivoting around one wheel.Other motions can also be used. For example, maneuvers may be performedwith non-zero differential between drive wheels (e.g., |d_(r)|−|d_(l)|).In an example embodiment, the N first heading estimates Δα_(odom,n)(n=1, 2, . . . , N) may be generated from the odometry measurements byutilizing Equation 1. The N second heading estimates Δα_(gyro,n) (n=1,2, . . . , N) may be generated by the gyroscopic sensors. In someembodiments, the pairs of measurements (Δα_(odom,n), Δα_(gyro,n)) may becollected at approximate intervals, for example, whenever the roboticdevice 100 has rotated about 0.1 radians as compared to the lastreading. The difference in heading due to carpet drift Δα_(drift,n) maybe approximated by the following example equation.

Δα_(drift,n)=Δα_(gyro,n)−Δα_(odom,n) ∀n∈{1,2, . . . N}.  (Equation 6)

The method 410 a can proceed to block 506 for estimating a direction ofthe carpet drift based at least on difference in the comparisons made atblock 504. For example, the plot of Δα_(drift,n) over a completerotation can approximate a sinusoidal signal as modeled in Equation 5.The extrema or peak of the estimated heading change Δα_(drift,n) due tocarpet drift can occur approximately when the odometry sensors and thegyroscopic sensors differ the most. For example, when the robotic device100 is perfectly aligned with the direction of the carpet grain, theodometry sensors can under-estimate the turn angle and can lag behindthe heading measured by the gyroscopic sensor, resulting in a maxima.Conversely, the minima can occur when the robotic device 100 is alignedagainst the carpet grain and the odometry sensors can overestimate theturn angle. Accordingly, the carpet grain direction may be estimatedbased on a peak of the comparisons of the first and second headingestimates. Standard or non-standard correlation/convolution and/orsearch techniques may be used for this purpose.

The method 410 a can proceed to block 508 for estimating a magnitude ofthe carpet drift based at least on the total drift and the change ofheading. For example, an estimate of the carpet drift magnitude may beobtained using the following example equation:

$\begin{matrix}{{c} \approx \frac{\sum\limits_{n = 1}^{N}{\Delta\alpha}_{{drift},n}}{2\pi}} & \left( {{Equation}\mspace{14mu} 7} \right)\end{matrix}$

Equation 7 is the ratio of the total drift over one complete rotation(e.g., 2π). Other amounts of rotations may be used by replacing thedenominator of Equation 7 with the total change of the heading duringthe maneuver.

If the floor is not carpeted, the plot of Δα_(drift,n) may not resemblea sinusoidal wave having a period of N. Hence, if Δα_(drift,n) does nothave a fundamental period of N (or if Δα_(drift,n) does not have asubstantially sinusoidal waveform as expected from Equation 5), thefloor may be estimated or identified as not being carpeted. The method410 a can then proceed to block 510 to end.

One particular challenge of estimating carpet drift is that certaineffects of carpet drift cannot be detected with a gyroscopic sensor. Forexample, if the robotic device 100 is being commanded to follow astraight path, one aspect of carpet drift can influence the motion ofthe robotic device 100 (e.g., by changing the path angle) in a way thatdoes not substantially rotate or change the heading of the roboticdevice 100. For example, carpet drift can affect the translationalmotion of the robotic device 100 without rotating the robotic device100. Accordingly, a gyroscopic sensor may not be effective forestimating aspects of carpet drift during maneuvers that have asubstantially straight desired path (e.g., substantially zero absolutedifferential wheel displacements |d_(r)|−|d_(l)|) and/or when there isno substantial heading change. There is therefore a need for improvedestimation of carpet drift.

FIG. 6 is a flow diagram illustrating an example embodiment of a method410 b of estimating carpet drift based at least on measurements fromodometry and image sensors. For example, if the robotic device 100 isequipped with an imaging sensor such as a camera, image-basedmeasurements may be used to perform on-line estimation of the carpetdrift. In other example embodiments, the robotic device 100 may notinclude an integral imaging sensor. For example, images captured by anexternal camera may be communicated, for example, wirelessly to therobotic device 100. Additionally or alternatively, an external systemincluding a processor and a camera may image the robot and determinefrom the images the robotic device's 100 location and/or orientation andcommunicate the data to the robotic device 100. Accordingly, theimage-based estimation is described below in the context a fullyintegrated robot, but will be applicable to separate robot-camerasystems.

Image-based estimation may optionally be effective for environmentshaving multiple carpets, area rugs on hard floors, and other genericsurface arrangements. Image based sensing may be effective even insituations in which there is no substantial commanded wheel differential(e.g., during an approximately straight-line maneuver). In other words,the method 410 b may be effective for estimating carpet drift duringmaneuvers in which the robotic device 100 is not commanded to rotate. Inan example embodiment, the robotic device 100 executes instructions ofthe estimation module 312 in memory 304 for performing the operations ofthe method 410 b.

The method 410 b starts at block 602 and proceeds to block 604 fordetermining a visual observation of motion from two or more imagescaptured by the image sensor. There are various methods to determinevisual observations of motion from visual information, includingepipolar matching, visual odometry, phase correlation, and structurefrom motion. It will be appreciated by one skilled in the art that anysuitable method for determining the visual observation may be used. Anexample embodiment involving epipolar matching is described in greaterdetail below in connection with FIG. 7.

After determining the visual observation of motion, the method 410 bproceeds to block 606 for executing a statistical filter. Estimates ofthe robotic device's 100 motion extracted from camera images may becombined using a statistical estimation filter. The statisticalestimation filter can maintain an estimate of the carpet drift or carpetdrift vector. There are various statistical estimation filters that cancombine the visual observations including variants of Extended KalmanFilters (EKF), Extended Information Filters, non-linear optimization,and particle filters. An example embodiment that uses an iterative EKF(IEKF) is described in greater detail below in connection with FIG. 8.The method 410 b can end at block 608.

In an example embodiment, the robotic device 100 may implement only oneof the methods 410 a or 410 b. Another example embodiment, however, mayimplement both the methods 410 a, 410 b and switch between the twomethods or modes during operation. For example, the robotic device 100may include both a gyroscopic sensor and an image sensor. The roboticdevice 100 may execute method 410 a during a calibration phase and/orduring certain maneuvers in which the robotic device 100 is commanded torotate. In addition, the robotic device 100 may execute method 410 bduring certain maneuvers in which the robotic device 100 is notcommanded to rotate. For example, in a particular example embodiment therobotic device 100 may be configured to repeatedly traverse between twowalls in order to clean a floor of a room. As such, the robotic device100 may be configured to move in a substantially straight line from onewall to the other wall. During this straight-line maneuver, the roboticdevice 100 may be configured to selectively execute method 410 b. Whenthe robotic device 100 encounters the other wall, the robotic device 100may be configured to rotate (e.g., approximately 180 degrees) to facethe first wall. During this turning maneuver, the robotic device 100 maybe configured to selectively execute method 410 a.

Another example embodiment, however, may run both the methods 410 a, 410b in parallel and switch between the two methods during operation. Forexample, the controller 108 of FIG. 1 may monitor the operation of themethods 410 a, 410 b to select the output that may provide the mostreliable estimates. For example, the controller 108 may select to usethe output of the process executing method 410 a when the wheeldifferential (e.g., |d_(r)|−|d_(l)|) is large, or select away when thewheel differential is small. As another example, the controller 108 mayselect to use the output of the process executing method 410 b whenthere are indications of accurate visual observation of motion. Forexample, as described below in further detail in connection with FIG. 7,the method 410 b may calculate certainty levels and can measure thecloseness of feature matches. In an example embodiment, method 410 b maybe selected when there is low uncertainty and/or close feature matches.

Additionally or alternatively, to aid deciding between the two methods410 a, 410 b or modes, the controller 108 may compare two hypotheticalperformance metrics that can be evaluated and compared online. Forexample, the method 410 a may be assigned a performance metric P₁ withcan be evaluated online. One example choice for the metric may beP₁=μ₁(|d_(r)|−|d_(l)|)⁻², where μ₁ may be a design variable that can beselected based on application-specific considerations. Likewise, themethod 410 b may be assigned similar or different performance metric P₂.One example choice for the metric may be P₂=μ₂∥P∥, where μ₂ may be adesign variable that can be selected based on application-specificconsiderations and ∥P∥ may be a matrix norm of a covariance matrix P ofa Kalman Filter used to generate vision based estimates of the drift(see, e.g., FIG. 8). In an example embodiment, the controller 108 mayselect to use the output of method 410 a if P₁<P₂ and may select to usethe output of the method 410 b if P₂<P₁. It will be appreciated thatother performance metrics can be selected and other decision rules maybe used.

FIG. 7 is a flow diagram illustrating an example embodiment of a method604 of determining visual observation of motion. For example, in anexample embodiment the robotic device 100 executes instructions of theestimation module 312 in memory 304 to generate visual observationsindicative of the robotic device's 100 path angle from images capturedby imaging sensors. The illustrated embodiment of the method 604 isbased on epipolar matching of features detected in the images. Epipolarmatching estimates translation (e.g., when using multiple cameras),translation direction, and rotation of the camera in one image toanother image by an epipolar relationship between matching features ofthe images. For example, the change of the position and/or orientationof a detected feature in one image relative to another image can providean indication of the motion of the camera relative to the detectedfeature. For simplicity, “translation” as used below may refer totranslation and/or translation direction. For example, in the case of anexample embodiment having a single camera, translation direction can beestimated. Advantageously, epipolar matching may not require knowledgeof the structure of the scene that the camera is imaging (although suchknowledge may be used). One aspect of the example visual estimator is tofind an estimate of the translation that has low uncertainty and enoughtranslation relative to the depth of objects in the scene. For example,this type of estimate may be useful as an observation for processing bya statistical estimation filter. Since epipolar matching may beeffective with two images at time, it may use less computation thanother visual motion estimation methods, for example, based on structurefrom motion. In an example embodiment, the robotic device 100 executesinstructions of the estimation module 312 in memory 304 for performingthe operations of the method 604.

The method 604 starts at block 702 and proceeds to block 704 forinitialization by setting a saved feature set to an empty set and byresetting the odometry measurements. For example, the saved feature setmay be stored in the memory 304 of the robotic device 100. Afterresetting the odometry, the method 604 proceeds to block 706 forretrieving the next odometry data and the next camera frame (e.g.,image). For example, the robotic device 100 can move across the surfaceand can collect odometry measurements with a first set of sensor thatincludes odometry sensors and collect the next frame with a second setof sensors that includes one or more cameras.

After collecting the next frame, the method can move from block 706 toblock 708 for extracting a current feature set of the frame. Forexample, features such as scale invariant feature transformation (SIFT),Harris features, or the like may be extracted from the frame. At block710, the method 604 checks if the saved feature set is the empty set. Ifthe saved features set is the empty set, the method 604 proceeds toblock 712 for storing the current feature set to the saved feature setand for resetting the accumulated odometry. The method 604 can return toblock 706 for retrieving the next odometry data and camera frame.

If, at block 710, the saved feature set is not empty, the methodproceeds to block 714 for finding epipolar matches between the currentfeature set and the saved feature set. After finding the epipolarmatches, the method 604 can proceed to block 716 for checking thethreshold of the matching. For example, the method 604 can check thesufficiency of the matches. In particular, the feature matching may beassisted by information about the expected motion from other sources inthe system such as odometry or other visual motion estimators. Thematches are accepted if enough features match and the error between thematches (e.g., the residual) is low enough. For example, the matchesmeet the threshold if the number of the matches exceeds a thresholdmount, the uncertainty of the matches is below a certain limit, and/orthe difference between the motion of the matches and the motionpredicted by odometry is below a threshold. Accordingly, the matches maybe based on reliable measurements, and so it is determined that thematches can be used. On the other hand, matches that include too fewmatching features or large errors between the matches may indicate thepresence unreliable measurements and thus it is determined that thematches should not be used.

If the matches do not meet the threshold, the method 604 proceeds toblock 712 for storing the current feature set to the saved feature setand for resetting the accumulated odometry. The method 604 can return toblock 706 for retrieving the next odometry data and camera frame.

If the matches do meet the threshold at block 716, the method proceedsto block 718 for computing the rotation and translation of the camerabetween the saved feature set and the current feature set. For example,the computed rotation and translation of the camera may be based on theepipolar relationship between the current feature set and the savedfeature set. For instance, translation and rotation of features in theframe coordinates can be mapped to translation and rotation of, forexample, the camera relative to a fixed or inertial frame (such as theroom) according to geometric relationships. In example embodiments, themapping from epipolar coordinates to translation and rotation of thecamera can be computed by using numerical optimization or mathematicalprogramming functions or methods.

After computing the rotation and the translation, the method 604proceeds to block 720 for determining if the rotation and translationmeet some thresholds. If the thresholds are met, the method 604 proceedsto block 721 for setting a visual observation of motion. For example, ifthe rotation and translation have a magnitude above a threshold anduncertainty is below a threshold, a visual motion observation may begenerated, and the method 604 can terminate at block 722. The visualobservation of motion can include one or more of an estimated change inpose, an uncertainty of the estimate, and a change in odometry-basedpose between the two camera positions.

On the other hand, if the rotation and/or translation have a magnitudebelow a threshold or the uncertainty is above a threshold, the method604 can move from block 720 to block 706 for retrieving the nextodometry data and camera frame. Accordingly, the saved feature set isnot changed and a new image and odometry data is retrieved. This wayanother observation attempt may be made when there is enough motionbetween matched frames. One optional advantage, among others, ofapplying a threshold to the observed rotation and the translation is toimprove performance in the presence of image noise (e.g., camera jitterand sensor noise).

As stated above, uncertainty of the rotation and/or translation may beincluded in the visual observation of motion. Uncertainty informationcan be useful in some example embodiments for determining the degreeupon which visual information can be relied. For example, visualobservations associated with relatively low uncertainty may be weightedmore heavily than visual observations associated with relatively highuncertainty. To that end, the uncertainty of the visual observation maybe determined by various factors, such as the uncertainty associatedwith the current and/or saved feature sets extracted at block 708. Inaddition, the uncertainty of the visual observation may be determined bythe closeness of the matching found at block 714. Epipolar matches withclose matching may have less uncertainty assigned than does epipolarmatches with weak matching.

Uncertainty at the feature set level can be based on predetermineduncertainty levels (e.g., design choices and/or assumptions based on theapplication), on characteristics of the features, and characteristics ofthe images. For example, certain features may provide higher qualitymatching than other features. For instances, particular shapes may matchmore easily than other. For example, features with sharp, high-contrastedges may be associated with less uncertainty than features having onlyblurry or low-contrast edges. In addition, features having corners maybe associated with lower uncertainty.

Uncertainties at the feature level can be mapped to uncertainties at therotation and translation level (e.g., the visual observation level). Forexample, the uncertainties can be input into the function of block 718for mapping the epipolar domain to the translation and rotation domain.

FIG. 8 is a flow diagram illustrating an example embodiment of a method606 of FIG. 6 of executing a statistical filter. In the illustratedembodiment, an IEKF may be used to track a normalized carpet driftvector (NCDV). The NCDV is the carpet drift vector per unit oftranslation. The NCDV may be a property of the floor surface and may beindependent of how far the robot travels and the robot's orientation.The IEKF of the illustrated embodiment may be used to estimate of theNCDV, as described below in further detail. For example, the stateestimate x of the IEKF can correspond to an estimate of the NCDV, andthe covariance of the state x may be denoted by P. One optionaladvantage of using an IEKF over a standard EKF is improved accuracy byreducing the errors due to linearization. It will be appreciated by oneskilled in the art that other estimation techniques could also be used.In an example embodiment, the robotic device 100 executes instructionsof the estimation module 312 in memory 304 for performing the operationsof the method 606.

Accordingly, the method 606 starts at block 802 and proceeds block 803to retrieve the visual observation of motion. For example, the visualobservations may be determined according to method 604 described inconnection with FIG. 7. The visual motion observation may containinformation related to the estimated relative pose Ω of the roboticdevice 100 from time t_(i) to t_(i)+1. Pose may refer to translation,translation direction, and/or orientation information. For example, thevisual motion observation may be transformed into the following form: arelative pose Ω estimated from odometry and associated covariance B; adirection θ of motion in the ground plane estimated by image processing(e.g., by block 604 of FIG. 6) and associated variance r. If the cameracoordinate frame and robot coordinate frame are not the same, oneskilled in the art would appreciate that the appropriate transformationshould be applied to the visual motion estimate and its associatedcovariance to put it in the appropriate coordinates (e.g., in the roomcoordinates). Also given is the estimated orientation of the robot inthe form of a rotation matrix M which rotates the state x into thecoordinate frame of Ω at t_(i)+1.

After retrieving the visual observation data at block 803, the method606 proceeds to block 804 for estimating an angle {tilde over (θ)} oftravel based on odometry and a current state estimate {circumflex over(x)}. Formulaically, the following equations may be used to generate theestimates of the angle {tilde over (θ)} of travel based on odometry andthe current state estimate {circumflex over (x)}:

$\begin{matrix}{h = {\Omega + {{d \cdot M}\hat{x}}}} & \left( {{Equation}\mspace{14mu} 7} \right) \\{\overset{\sim}{\theta} = {\arctan \; 2\left( {h_{1},h_{0}} \right)}} & \left( {{Equation}\mspace{14mu} 8} \right) \\{J_{h} = \frac{\left( {{- h_{1}}\mspace{14mu} h_{0}} \right)}{{h}^{2}}} & \left( {{Equation}\mspace{14mu} 9} \right) \\{H = {J_{h}{BJ}_{h}^{T}}} & \left( {{Equation}\mspace{14mu} 10} \right)\end{matrix}$

In Equation 7, the distance d is the estimated distance traveled betweent_(i) to t_(i)+1 based on odometry. In Equation 8, the components h₀ andh₁ are the components of vector h.

After estimating the angle of travel {tilde over (θ)}, the method 606moves from block 804 to block 806 for computing the Jacobian J_(d) ofthe change in the predicted angle {tilde over (θ)} with respect to thechange in state {circumflex over (x)}. For example, in some embodimentsthe Jacobian may be computed as J_(d)=(d·M⁻¹J_(h) ^(T))^(T).

The method 606 proceeds from block 806 to block 808 to compute theinnovation v and innovation variance Q. For example, in some embodimentsthe innovation v and innovation variance Q may be computed by using thefollowing equations:

v=θ−{tilde over (θ)}  (Equation 11)

R=r+H  (Equation 12)

Q=R+J _(d) PJ _(d) ^(T)  (Equation 13)

After the innovation v and innovation variance Q become available, themethod 606 proceeds from block 806 to gate the observation by comparingthe innovation v to the innovation variance Q. The method 606 proceedsfrom block 810 to block 812 to update the new mean {circumflex over(x)}_(next). For example, the new mean {circumflex over (x)}_(next) maybe the mean {circumflex over (x)} for the next iteration. In an exampleembodiment, the new mean {circumflex over (x)}_(next) may be computed bythe following equations:

v ₀ =x−{circumflex over (x)}  (Equation 14)

Y=J _(d) R ⁻¹ J _(d) ^(T)  (Equation 15)

b=P ⁻¹ v ₀ +J _(d) ^(T) R ⁻¹ v  (Equation 16)

{circumflex over (x)} _(next) ={circumflex over (x)}+(Y+P ⁻¹)⁻¹b  (Equation 17)

After completing one iteration of blocks 804-812, the method 606proceeds to block 814 to check whether the method should proceed withanother iteration or terminate at block 816. If the iterations arecompleted, the new state x={circumflex over (x)}_(next) and varianceP=(Y+P⁻¹)⁻¹ may be set. The number of iterations for the IEKF may bedetermined based in whole or in part on difference in state betweeniterations, or based on a fixed number of iterations.

A corrected odometry estimate may be obtained by applying the NCDV tothe odometry at each time step. For example, given the odometry changein pose Ω and the estimated NCDV x, the corrected odometry change inpose may be estimated by Ω_(c)=Ω+d·Mx. As previously stated above, thequantity d is the estimated distance traveled from odometry and H is theestimated orientation of the robot in the form of a rotation matrix thatrotates the estimated NCDV x into the coordinate frame of Ω.

Thus, systems and methods are described for estimating drift, such ascarpet drift experienced by a robot moving across a carpet, and forcompensating for such carpet drift.

The foregoing description and claims may refer to elements or featuresas being “connected” or “coupled” together. As used herein, unlessexpressly stated otherwise, “connected” means that one element/featureis directly or indirectly connected to another element/feature, and notnecessarily mechanically. Likewise, unless expressly stated otherwise,“coupled” means that one element/feature is directly or indirectlycoupled to another element/feature, and not necessarily mechanically.Thus, although the various schematics shown in the figures depictexample arrangements of elements and components, additional interveningelements, devices, features, or components may be present in an actualembodiment (assuming that the functionality of the depicted circuits isnot adversely affected).

The methods and processes described herein may have fewer or additionalsteps or states and the steps or states may be performed in a differentorder. Not all steps or states need to be reached. The methods andprocesses described herein may be embodied in, and fully or partiallyautomated via, software code modules executed by one or more generaland/or specialized computers. The code modules may be stored in any typeof computer-readable medium or other computer storage device. Theresults of the disclosed methods may be stored in any type of computerdata repository that use volatile and/or non-volatile memory (e.g.,magnetic disk storage, optical storage, EEPROM and/or solid state RAM).

Although this invention has been described in terms of certainembodiments, other embodiments that are apparent to those of ordinaryskill in the art, including embodiments that do not provide all of thefeatures and advantages set forth herein, are also within the scope ofthis invention. Moreover, the various embodiments described above can becombined to provide further embodiments. In addition, certain featuresshown in the context of one embodiment can be incorporated into otherembodiments as well.

1. (canceled)
 2. A robotic device, comprising: one or more sensors; anactuator system; and a controller configured to: generate a drive signalto the actuator system to maneuver the robotic device across a surfaceincluding a portion of a substantially straight path; receive sensordata from the one or more sensors, the sensor data indicative of amotion characteristic of the robotic device moving across the surface;estimate a drift using the received sensor data; and determine whetherthe surface is carpeted or non-carpeted based on the estimated drift. 3.The robotic device of claim 2, wherein the controller is configured toestimate the drift including to determine a drift vector using thereceived sensor data, and to determine whether the surface is carpetedor non-carpeted based on a magnitude or a direction of the drift vector.4. The robotic device of claim 2, wherein the controller is configuredto determine a change in heading of the robotic device using thereceived sensor data, and to estimate the drift based at least on thedetermined change in heading.
 5. The robotic device of claim 4, whereinthe controller is configured to generate a first heading estimate usinga first sensor and a second heading estimate using a second sensordifferent from the first sensor, and to determine the change in headingbased on a comparison between the first and the second headingestimates.
 6. The robotic device of claim 5, wherein the first sensor isan odometry sensor, and the second sensor is a gyroscopic sensor.
 7. Therobotic device of claim 2, wherein the controller is configured todetermine a change in path angle using the received sensor data, and toestimate the drift based at least on the determined change in pathangle.
 8. The robotic device of claim 7, wherein the controller isconfigured to determine the change in path angle using imaging datasensed by an imaging sensor.
 9. The robotic device of claim 2, whereinthe received sensor data include odometry data sensed by an odometrysensor, and wherein the controller is configured to adjust the odometrydata using the estimated drift.
 10. The robotic device of claim 9,wherein the controller is configured to adjust the odometry data using acorrection term proportional to a grain magnitude along a graindirection on a carpeted surface.
 11. The robotic device of claim 9,wherein the controller is configured to determine a position or a poseof the robotic device using the adjusted odometry data.
 12. The roboticdevice of claim 2, wherein the received sensor data include visualobservations of motion as the robotic device moves across the surface.13. The robotic device of claim 2, wherein the received sensor datainclude imaging data sensed by an imaging sensor as the robotic devicemoves across the surface.
 14. The robotic device of claim 2, wherein thecontroller is configured to generate a control signal to the actuatorsystem to compensate for the estimated drift and to maintain the roboticdevice on a planned path.
 15. A method of operating a robotic devicecomprising one or more sensors, an actuator system, and a controller,the method comprising: generating, by the controller, a drive signal tothe actuator system to maneuver the robotic device across a surfaceincluding a portion of a substantially straight path; receiving, fromthe one or more sensors, data indicative of a motion characteristic ofthe robotic device moving across the surface; estimating, by thecontroller, a drift using the received sensor data; and determining, bythe controller, whether the surface is carpeted or non-carpeted based onthe estimated drift.
 16. The method of claim 15, wherein: estimating thedrift includes determining a drift vector using the received sensordata; and determining whether the surface is carpeted or non-carpeted isbased on a magnitude or a direction of the drift vector.
 17. The methodof claim 15, comprising: generating a first heading estimate using anodometry sensor and a second heading estimate using a gyroscopic sensor;and determining a change in heading based on a comparison between thefirst and second heading estimates; wherein estimating the drift isbased at least on the determined change in heading.
 18. The method ofclaim 15, comprising determining a change in path angle using imagingdata sensed by an imaging sensor, wherein estimating the drift is basedat least on the determined change in path angle.
 19. The method of claim15, wherein the received sensor data include odometry data sensed by anodometry sensor as the robotic device moves across the surface, themethod further comprising adjusting the odometry data using theestimated drift.
 20. A robotic device, comprising: one or more sensors;an actuator system; and a controller configured to: generate a drivesignal to the actuator system to maneuver the robotic device across asurface including a portion of a substantially straight path; receivesensor data indicative of a motion characteristic of the robotic devicemoving across the surface, the sensor data including odometry datasensed by an odometry sensor; estimate a drift using the received sensordata; and adjust the odometry data using the estimated drift.
 21. Therobotic device of claim 20, wherein the controller is configured to:adjust the odometry data using a correction term proportional to a grainmagnitude along a grain direction on a carpeted surface; and determine aposition or a pose of the robotic device using the adjusted odometrydata.